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1. 


INTRODUCTION 


1 . 1 BACKGROUND 

A tactical  missile  guidance  system  may  require  an 
accurate  estimate  of  missile-target  range.  Acceptable  accu-  | 

racy  can  usually  be  achieved  using  direct  radar  range  mea-  | 

f 

surement  techniques.  However,  it  is  a distinct  possibility  j 

that  radar  range  information  may  not  be  available,  either 

due  to  electronic  jamming  by  the  hostile  target,  or  due  to 

the  use  of  a passive  seeker  (with  infrared  or  electro-optical 

sensors,  for  example).*  In  either  case,  the  missile  guidance 

system  will  generally  be  able  to  measure  target  bearing  or 

line-of-sight  (LOS)  angle.  It  is  thus  important  to  develop 

passive  range  estimation  techniques,  based  on  the  assumption 

that  LOS  angle  is  the  only  information  available  regarding 

the  relative  position  of  the  target  from  the  missile. 

One  application  where  range  estimation  is  of  inter- 
(>.st  i.s  a homing  guidance  system  attempting  to  intercept  a 
surface  target  (land  or  sea).  A recent  feasibility  studv 
undertaken  at  TASC  has  demonstrated  that  a sophisticated, 
inert ial ly-aided . data  processing  algorithm  (filter)  can 
provide  quite  accurate  estimates  of  range  in  an  antiship- 
ping missile  application  when  the  missile  performs  a termi- 
nal pitch-up  maneuver  (Ref.  1).  In  that  investigation,  an 


*If  it  is  anticipated  that  range  measurements  may  be  denied 
by  jf'jiuning,  then  a home-on-jam  capability  can  be  incorpo- 
rated in  the  target  tracking  system,  while  passive  seekers 
are  specifically  designed  to  provide  LOS  angle  information 
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extended  Kalman  filter  was  provided  with  measurements  of  LOS 
angle,  missile  acceleration,  missile  altitude,  and  missile 
attitude.  Range  estimation  was  greatly  facilitated  by  the 
terminal  missile  pitch-up  maneuver  performed  to  achieve  an 
advantageous  target  approach  angle.  Furthermore,  the  success 
of  the  extended  Kalman  filter  was  due  in  part  to  the  assump- 
tion that  initial  estimation  errors  were  relatively  small  — 
as  might  be  the  case  if  radar  range  measurements  were  avail- 
able up  to  the  filter  initialization  time. 

In  many  missile  guidance  situations,  it  is  important 
to  be  able  to  obtain  good  range  estimates  at  relatively 
long  ranges  were  LOS  angular  excursions  are  small.  If  it  is 
necessary  to  perform  a terminal  maneuver,  for  example,  it 
would  be  important  to  initiate  the  maneuver  at  the  correct 
missile-target  separation.  It  may  also  be  necessary  to  have 
an  accurate  passive  ranging  capability  when  initial  range 
estimates  are  poor.  These  requirements  provide  the  motiva- 
tion for  the  present  detailed  investigation  of  passive  range 
estimation  algorithms. 

The  essentials  of  the  problem  under  consideration 
are  depicted  in  Fig.  1.1-1.  In  this  study,  the  equations  of 
motion  are  expressed  in  Cartesian  coordinates,  x and  y, 
representing  missile-target  separation.  This  formulation 
leads  to  system  dynamics  that  can  be  approximated  with  a 
linear  .model,  and  to  a measurement  equation  that  contains  the 
nonlinearity 


6 = tan~^(y/x)  (1.1-1) 

where  6 is  the  LOS  angle.  While  the  use  of  polar  coordinates 
would  lead  to  a linear  measurement  equation,  the  system  dynamic 
equations  that  result  contain  a number  of  highly  nonlinear 
terms.  Cartesian  coordinates  are  chosen  so  that  attention 
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can  be  restricted  to  a single  dominant  nonlinearity — the  LOS 
angle  measurement  equation  indicated  in  Eq.  (1.1-1).  An 
additional  secondary  nonlinear  effect  that  may  appear  in  the 
above  measurement  equation  is  LOS  angle  quantization.  The 
impact  of  LOS  angular  quantization  on  the  range  estimation 
problem  is  studied  here  as  well. 


e 


It  is  assumed  that  the  measurement  data  consists  of 
noisy  measurements  of  0 and  noise-free  measurements  of  the 
missile  acceleration.  The  motion  of  the  target  (ship)  is 
modeled  as  a horizontal  acceleration  vector,  a^ . with  a mag- 
nitude that  is  a correlated  gaussian  random  process  with 
bandwidth  and  rms  value  selected  appropriately.  Mathematical 
details  concerning  the  system  model  may  be  found  ii.  Chapter  2. 


% 


I 


The  above  paragraphs  outline  the  motivation  for,  and 
provide  an  overview  of,  the  range  estimation  problem  considere 
in  this  investigation.  In  the  next  section,  an  outline  of 
possible  filter  design  techniques  that  may  fulfill  the  need 
for  accurate  estimates  of  missile-target  separation  is  pre- 
sented. 
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1.2  tk:hnical  approach 

The  optimal  estimation  probl^  for  linear  systems 
has  been  solved  (Ref.  2).  The  well-known  Kalman  filter  algo- 
rithm results  in  a set  of  recursive  relations  with  which 
each  measurement  can  be  processed  to  yield  an  updated  esti- 
mate of  the  syst«n  variables  of  interest-  The  estimate  pro- 
vided by  the  Kalman  filter  is  optimal,  in  the  sense  that  the 
variance  of  the  estimation  error  is  minimized.  One  essential 
property  of  this  approach  is  that  an  exact  replica  of  the 
linear  system  model  is  incorporated  in  the  algorithm;  the 
performance  of  the  filter  is  impaired  if  this  model  inaccu- 
rately reflects  the  real  world.  The  relation  between  the 
linear  systan  model  and  the  optimal  Kalman  filter  is  por- 
trayed in  Fig.  1.2-1 
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While  the  technique  outlined  above  has  proven  to 
be  very  successful  in  applications  where  the  assumption  of 
linearity  is  realistic,  the  extension  of  optimal  estima- 
tion methodology  to  the  nonlinear  case  is  not  necessarily 
straightforward.  A widely-used  solution  to  the  nonlinear 
filtering  problem  is  the  extended  Kalman  Filter  (Ref,  2); 
it  is  depicted  in  Fig.  1.2-2  in  the  same  conceptual  terms 
as  the  Kalman  filter  shown  in  Fig.  1.2-1.  The  implementa- 
tion of  the  resulting  algorithm  calls  for  replacing  all  sys- 
tem nonlinearities  with  linear  gains  that  are  equal  to  the 
slopes  of  the  nonlinearities;  the  slopes  are  computed  at  the 
present  estimate  of  the  system  variables,  x.  This  pro- 
cedure is  called  small-signal  linearization  about  the  cur- 
rent estimate.  It  is  accurate  (i.e.,  provides  a realistic 
systCTJ  model  for  incorporation  in  the  filter  algorithm)  as 
long  as  estimation  error  is  small  and  changes  in  the  slopes 
of  the  nonlinearities  are  small  over  the  region  of  interest. 
Clearly,  these  conditions  may  be  restrictive,  and  they 
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FiRuro  1.2-1  Kalman  Filter  Design  Principles 

for  Linear  Systems 


raise  questions  as  to  how  "small”  the  estimation  error  and 
slope  variations  must  be,  and  how  much  the  filter  perform- 
ance is  degraded  when  the  conditions  are  violated.  None- 
theless, there  have  been  many  applications  in  which  the 
(•xtended  Kalman  filter  has  proven  to  be  effective. 

If  the  underlying  assumptions  of  the  extended 
Kalman  filter  design  approach  are  questionable,  as  may  be 
the  case  in  applications  of  the  sort  considered  here,  then 
more  sophisticated  solutions  to  the  nonlinear  filtering 
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Extended  Kalman  Filter  Design 
Principles  for  Nonlinear  .lystems 


problem  could  be  required.  One  possible  approach  is  based 
on  describing  function  theory,  and  can  be  called  the  quasi- 
1 inear  Kalman  filter  design.  This  concept,  which  involves 
replacing  each  system  nonlinearity  with  a random-input 
describing  function  (Ref.  3),  is  illustrated  in  Fig.  1.2-3; 
it  is  an  alternative  design  technique  investigated  in  this 
study . 
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FiRure  1.2-3  Quasi-Linear  Kalman  Filter  Design 

Principles  for  Nonlinear  Systems 


The  fact  that  nonlinear  filtering  is  not  amenable  to 
a unified,  dependable  methodology  is  compensated  to  some 
extent  by  the  existence  of  the  nram4r-Rao  inequality.  In 
some  instances,  this  inequality  defines  lower  bounds  on  the 
filter  estimation  error  variance  that  can  be  achieved  by 
the  best  possible  filter,  even  if  such  a filter  is  unknown. 
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Given  a Cramer-Rao  lower  bou.  i on  achievable  estimation 
error  variance,  it  is  possible  to  assess  how  well  existing 
filters  are  performing  a ; cific  nonlinear  filtering  task. 
If  a candidate  filter  provides  estimation  errors  that  are 
comparable  to  the  Cram4r~A<ao  lower  bound,  then  there  is 
little  to  be  gained  by  using  other  algorithms. 

The  goal  of  this  investigation  is  to  determine  the 
performance  of  the  extended  Kalman  filter  and  of  several 
forms  of  the  quasi-linear  Kalman  filter  in  the  range  esti- 
mation problem  outlined  in  Section  1.1.  Direct  comparison 
of  the  performance  of  these  filter  algorithms  provides  a 
great  deal  of  insight  into  their  strengths  and  weaknesses, 
and  the  Cram6r-Rao  inequality  is  useful  in  assessing  their 
absolute  performance. 

1.3  REPORT  OUTLINE 

The  subsequent  chapters  of  this  report  contain  the 
following  material:  Chapter  2 is  concerned  with  the  develop- 
ment of  the  system  model  and  the  derivation  of  the  extended 
and  quasi-linear  Kalman  filter  algorithms,  Chapter  3 deals 
'./ith  direct  performance  comparisons  of  the  two  types  of 
algorithms  in  a few  key  situations,  and  Chapter  4 presents 
a summary  of  tht  investigauion  and  the  conclusions  derived 
from  the  study.  Appendix  A provides  an  overview  of  non- 
linear estimation  theory,  and  Appendix  B treats  the  evalua- 
tion of  random-input  describing  functions  for  the  arctangent 
nonlinearity  involved  in  the  bearing  measurement  equation. 
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2. 


MODEL  DEVELOPMENT 


In  this  chapter,  the  range  estimation  problem 
under  investigation  is  specified- by  deriving  a simple  mathe- 
matical model  Lo  represent  the  missile  and  target  dynamics. 

One  essential  nonlinear  effect  is  incorporated:  the  LOS 

angle  measurement  relation  (Eq.  (1.1-1)).  The  model  described 
here  is  quite  similar  to  that  of  Ref.  1;  the  problem  has 
been  simplified,  however,  by  the  exclusion  of  some  secondary 
error  sources  (altimeter  bias  and  random  altitude  measure- 
mer. t error,  accelerometer  bias,  attitude  reference  tilt  and 
gy:o  drift).  The  elimination  of  these  error  sources  does 
not  compromise  the  degree  of  realism  lecessary  to  achieve 
the  goals  of  the  study. 

2.1  TARGET  MOTION  MODEL 

The  range  estimation  problem  outlined  in  Section 

1.1  deals  with  the  planar  intercept  case,  with  the  motion 
of  the  target  constrained  to  be  along  the  horizontal  or  x 
axis  (Fig.  1.1-1).  We  assume  that  the  target  acceleration 
magnitude,  a^,  is  a first-order  Markov  process,  modeled  as 
a zero-mean  gaussian  white  noise  process,  w,  passed 
through  a single  stage  of  low-pass  filtering,  as  depicted 

in  Fig.  2.1-1.  By  suitably  adjusting  thr  values  of  the  tar- 
get maneuver  bandwidth,  , and  acceleration  rms  level, 
o , a wide  variety  of  random  target  maneuvers  can  be  real- 
istically  represented.  A constant  rms  level  of  horizontal 
acceleration  is  assumed  for  the  present  study,* 


*E[]  denotes  the  expected  value  of  the  bracketed  variable. 
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Figure  2.1-1  Target  Maneuver  Model 


E[a^(t)]  . 

To  achieve  this  condition,  the  spectral  density  of  the 
white  noise  process,  q,  is  specified  by 

E|^w(t)w(T)J  = q 6(t-T)  = 6(t-x) 


(2.1-1) 


(2.1-2) 


A ship  of  moderate  maneuverability  can  be  modeled  by  choos- 
ing the  bandwidth  and  rms  acceleration  level  to  be  0.05  rad/sec 

o 

and  3.22  ft/sec'^  (O.lg),  respectively.  The  target  horizontal 
velocity  and  position  in  an  earth-fixed  inertial  frame,  v^ 
and  Xj.  respectively,  are  then  obtained  by  integration 
(Fig.  2.1-1) 


2.2  MISSILE  TRAJECTORY  GENERATOR 


The  motion  of  the  missile  with  respect  to  an  earth- 
fixed  inertial  frame  is  modeled  deterministically  by  a 
trajectory  generator  that  produces  a specified  time  history 
of  missile  position,  x^^^  and  y^^^,  missile  velocity,  Vjjj^  and 
VjUy,  and  missile  acceleration,  a^j^^  and  ^^my*  in  Cartesian 
coordinates.  By  utilizing  the  specified  trajectory,  the 
need  for  modeling  the  guidance  and  control  system  is  avoided. 
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Furthermore,  by  removing  the  range  estimation  function  from 
the  guidance  and  control  loop,  it  is  guaranteed  that  the 
same  trajectory  will  be  followed  in  each  case  studied,  making 
the  filter  performance  evaluations  exactly  comparable. 

The  trajectory  is  qualitatively  similar  to  that 
portrayed  in  i'5.g.  1.1-1,  i.e.  , there  is  an  initial  low- 
altitude  cruise  phase  of  7.2  sec  followed  by  a pitch-up  ter- 
minal maneuver.  Details  of  the  trajectory,  expressed  in 
normalized  units,  are  given  in  Chapter  3. 


2.3  STATE  VECTOR  DIFFERENTIAL  EQUATION  AND 
MEASUREMENT  MODEL 

The  five  state  variables  used  in  the  missile-target 
ranging  problem  are  indicated  in  Table  2.3-1.  Observe  that 
the  horizontal  separation  and  separation  rate  are  relative, 
i.e.,  the  state  variables  and  X2  represent  the  horizontal 
displacement  and  velocity  from  the  missile  to  the  target. 

The  state  vector  differential  equation  then  has  one  random 
input  w (Fig.  2.1-1)  and  two  deterministic  or  known  inputs, 
and  a^jy,  which  are  henceforth  denoted  by  u^^  and  Ug, 
respectively.  By  considering  the  missile  accelerations 
to  be  deterministic  filter  inputs,  it  is  assumed  that  errors 
that  may  arise  in  the  resolved  body-mounted  accelerometer 
measurements  are  negligible  in  comparison  with  the  LOS  angle 
measurement  errors.  In  terms  of  the  above  variables,  the 
relative  missile-target  motion  is  governed  by 

X = Fx  + gw  + Lu  (2.3-1) 


! 


S 

J 


TABLE  2.3-1 


STATE  VARIABLES  IN  THE  MISSILE-TARGET 
RANGE  ESTIMATION  PROBLEM 


STAl  ^ 
VARIAB^ 

ALTERNATIVE 

SYMBOL 

INTERPRETATION 

^1 

S-*t 

Missile-target  horizontal 
separation 

Missile-target  horizontal 
separation  rate 

*3 

Missile  altitude 

*4 

Missile  altitude  rate 

X6 

Target  horizontal  acceleration 

wftere 


0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

-1 

0 

1 

0 

0 

0 

0 

1 

0 

. £ = 

0 

, L = 

0 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

~“t 

_1 

_0 

0_ 

The  scalar  measurement  available  for  range  estima- 
tion is  a corrupted  observation  of  line-of-sight  angle  sampled 
at  times  tj^, 

= 0k  + Vk  , k = 0,1,2, , (2.3-3) 

where  it  is  assumed  that  the  sampling  rate  is  uniform, 

tj^  = kT  (2. 3-4) 

with  sampling  interval,  t.  The  measurement  noise  sequence 
v^  is  assumed  to  be  a zero-mean  gaussian  random  process  with 
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constant  variance  p , 

v’ 


l-k]  = « 

5[v^  = 


, k = 0,1,2, . . . 


A further  source  of  measurement  inaccuracy 
considered  in  this  investigation  is  quantization,  which  is 
denoted  by  the  nonlinear  operation  defined  by 


fq(z)  = 


6 sign  z , 
26  sign  z. 


I z|  < 6/2 
6/2  < lz|  < 36/2 
36/2  < Izl  < 56/2 


'N6  sign  z,  (2N-D6/2  ^ [z]  < » 

The  quantizer  output  takes  on  the  (2N+1)  discrete  values 
0,  +6.  ±26,...,±N6  as  z varies  continuously.  It  is  assumed 
that  quantization  occurs  after  the  corruption  of  the  LOS 
angle  measurement  by  the  random  sequence  Vj^, 


This  last  relation  is  the  most  general  measurement  equation 
considered  in  this  study. 


An  overview  of  the  system  dynamics  and  measurement 
model  is  provided  in  Fig.  2.3-1.  This  model  serves  as  the 
basis  for  the  design  of  filter  algorithms  to  estimate  target 
position,  velocity  and  acceleration  when  the  only  available 
measurement  of  relative  target  position  is  LOS  angle. 
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Figure  2.3-1  Mathematical  Model  for  the 

Range  Estimation  Problem 

2.4  LINEARIZED  MEASUREMENT  MODELS  AND  MODIFIED  KALMAN 
FILTER  ALGORITHMS 

2.4.1  Filter  Algorithms  When  Quantization  is  Absent 

Equations  (2.3-1)  to  (2.3-3)  provide  the  basis  for 
designing  both  the  extended  Kalman  filter  (EKF)  and  quasi- 
1 inear  Kalman  filter  (QKF)  for  the  range  estimation  problem 
when  quantization  is  not  present.  The  system  dynamics,  indi- 
cated in  Eq.  (2.3-1),  are  linear,  so  it  is  necessary  to  lin- 
earize only  the  measurement,  Eq.  (2.3-3).  Two  approaches 
are  used  in  this  study. 


‘ i 
li 

D 

0 


The  first  technique  considered  is  small-signal 
linearization  about  the  current  filter  estimate  of  the  state. 


=^S,k  ' 


(jf)!  . (>‘1-^1  > 

i \ 1/  'jj=X 


3x, 


tan 


‘ft) I .'■■■= 

' ' 'x=x 


3> 


- 0(x)  + X + 


(2.4-1) 
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The  vector  is  given  by 


I 

B 

D 

Q 

0 

Q 

0 

Q 

Q 

fl 

D 

n 

li 

S 


(2.4-2) 

••A  ^ 

and  x^x-x  is  the  difference  between  the  true  state  vector  and 
*he  current  estimate. 


The  second  linearization  technique  is  called  quasi- 
linearization (Ref.  3);  it  entails  replacing  Eq.  (2.3-3)  with 
the  random- input  describing  function  (ridf)  representation 


Zq.k  = e * hj  a * C2.4-3) 

In  this  approximation,  0 and  hg  are  given  by 

0 = Ej^tan“^(x2/Xj^)  j 


tan~^(x2/x 


(2.4-4) 


where  E[  ] denotes  expected  value,  x is  the  random  part  of  x, 

X - X - E(x] 


and  P is  the  associated  covariance  matrix, 

P ^ E[x  x"^] 

The  quantities  0,  defined  in  Eq.  (2.4-4)  satisfy  the  con- 
dition that  the  resulting  mean  square  error  in  approximat- 
ing Eq.  (2.3-3)  by  Eq.  (2.4-3)  is  minimized. 
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In  the  standard  ridf  methodology,  the  expected  values 
indicated  in  Eq.  (2.4-4)  are  evaluated  by  assuming  that  x is 
a vector  of  gaussian  random  variables  with  mean  m and  covar- 
iance matrix  P.  In  the  present  application,  m is  the  current 
state  estimate,  x,  and  P is  the  filter  covariance  matrix  which 
is  propagated  as  part  of  the  recursive  algorithm  detailed  sub- 
sequently. As  noted  in  Appendix  A,  the  gaussian  assumption 
results  in  the  dependence  of  the  ridf’s  on  x and  P alone: 

hq  = 

In  the  studies  described  in  Chapter  3,  three  dis- 
tinct quasi-linear  representations  of  arctan  (y/x)  are 
considered.  One  reason  for  this  multiplicity  is  that  § and 
defined  as  in  Eq.  (2.4-4)  cannot  be  evaluated  analytically 
in  closed  form  when  x and  y are  jointly  normal;  consequently 
two  approximate  techniques  have  been  applied  to  the  prob- 
lem. The  third  ridf  model  for  this  nonlinearity  is  based  on 
a nongaussian  density  function;  it  was  developed  to  study 
the  impact  of  the  gaussian  assumption  on  the  performance  of 
a quasi-linear  Kalman  filter  (QKF)  algorithm. 

The  most  accurate  gaussian-based  ridf  is  obtained  by 
numerical  integration;  the  filter  which  utilizes  that  approach 
is  designated  the  QKF-N  and  the  ridf  components  are  denoted 
llQii*  ^ simpler  ridf  representation  of  arctan  (y/x)  is 
obtained  by  a power  series  expansion  technique;  it  should  be 
noted  that  this  leads  to  ridf's  that  are  distribution  inde- 
pendent. The  corresponding  filter  algorithm  and  ridf  compo- 
nents are  called  the  QKF-P  and  Sp,  hQp,  respectively.  The 
third  quasi-linear  representation  is  based  on  a truncated 
and  folded  gaussian  density, 
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,(x.y)  = I 

( P(x,y)  + 


, X < 0 
p(-x,y)  , X > 0 


where  p(x,y)  is  the  joint  density  of  x and  y under  the 
gaussian  assumption  (cf.  Sq.  (B.1-5));  by  truncating  the 
density  at  x =■  0,  It  is  assumed  that  there  is  no  probabil:  cy 
that  the  missile  has  flown  past  the  ship.  Using  the  trun- 
cated density,  Eq.  (2.4-5),  numerical  integration  is  used  to 
obtain  9,j.,  hQ,j,;  substituting  these  results  in  the  quasi- 
linear  filter  algorithm  leads  to  the  QKF-T.  Details  con- 
cerning the  evaluation  of  these  ridf’s  are  given  in 
Appendix  B. 


The  above  linearized  measurement  models  are  nearly 
the  same  when  the  estimation  error  variances  (elements  of  P) 
are  small.  However,  if  there  is  significant  uncertainty  in 
the  estimate,  they  differ  considerably.  The  comparison  indi- 
cated in  Table  2.4-1,  normalized  to  a unity  altitude  estimate, 

TABLE  2.4-1 

COMPARISON  OF  SMALL-SIGNAL  LINEAR  AND 
QUASI-LINEAR  APPROXIMATIONS  OF  ARCTAN  (xo/xj)* 


Estimates  and 
Estimation  Error 
Variances 

«1  - 40.0  units  Pll  “ 

- 1.0  units  P13  • 0-0 

3 P33  - (0.2 

0 unlts)^ 
units)2 

Linearization 

Technique 

G(x)  or  8(rad) 

b^(rad/unlt) 

h^( rad/unit) 

Small-Signal 

2.5  X 10"^ 

-1.2S  X 10-5 

5. MO  X 10-4 

Quasl-Linear, 

Numerical  Integration 

1.00  X 10"^ 

-1.79  X 10-4 

8.25  X 10-4 

Quasl-Linear, 
Power  Series 

3.12  X 10-2 

-2.19  X 10-5 

6.24  X 10-4 

Quasi-Linear, 

Truncated  Density 

4.08  X 10~^ 

-2.95  X 10-5 

8.93  X 10-4 

unit’  denotes  a noraalized  length,  are  the  relevant  entries  of  P, 
and  hi,  ha  are  the  nonzero  elements  of  h-  or  h«. 
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Xg  = 1 . indicates  that  a 50  percent  uncertainty  in  the  hori- 
zontal separation  estimate  can  lead  to  large  disparities;  these 
conditions  may  not  be  unieasonable  during  the  cruise  phase. 

The  extended  Kalman  filter  (EKF)  algorithm  is 
mechanized  according  to  the  following  relations:  given 

— k state  vector  estimate  and  filter 

covariance  matrix  after  the  previous  measurement  and  update, 
the  filter  variables  satisfy 


Extrapolation  Between  Measurements 

y“^$(tj^-t)L  u(t)dt 
^k-1 

Pk(-)  = ^Pk-l^'^^^T  ^d  (2.4-6) 

where 

❖(t)  = exp(Ft) 

4 4>(t) 

*^d  - q/^  Kt-5)  ggVcT-OdC  (2.4-7) 

0 


and  q is  the  spectral  density  of  w (Eq.( 2. 1-2) ) , 
Update  at  a Measurement 

' 4'-)  * 4[^k  - 
= [i  - V-> 

where 

4 - * Pv) 


(2.4  6) 


(2.4-9) 
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The  first  step  of  the  above  procedure,  Eq.  (2.4-6),  propagates 
the  filter  estimate  over  the  time  period  between  measurements, 
according  to  the  linear  dynamic  model  of  Eqs.  (2.3-1)  and 
(2.3-2),  and  the  modification  of  P reflects  the  change  in 
estimation  errjr  covariance  during  the  same  interval.  The 
second  step,  Eq.  (2.4-8),  represents  the  use  of  the  current 
measurement  to  update  the  state  vector  estimate.  The 
auxiliary  matrices  indicated  in  Eqs.  (2.4-7).  and  (2.4-9)  are 
the  general  transition  matrix,  4'(t),  the  transition  matrix 
evaluated  over  one  sample  time,  4'^,  the  equivalent  discrete 
noise  matrix,  Q^,  and  the  Kalman  gain  vector,  kj^.  Equations 
(2.4-6)  to  (2.4-9)  are  the  particular  case  of  the  EKE  algorithm 
presented  in  Appendix  A. 


The  quasi-linear  Kalman  filter  (QKF)  for  the  present 
problem  differs  from  the  above  EKF  algorithm  only  in  tne 
update  step; 

= x^(-)  + 

(2.4-10) 

where 

IJ-k  - (2.4-11) 


I 

I 

1 

I 


I The  extrapolation  step  is  unchanged,  since  the  system  dynamics 

I equations  are  linear.  These  equations  are  considered  in  more 

, detail  in  Section  A. 3. 

I 

i 

• 

2.4.2  Filter  Algorithms  When  Quantization  is  Present 


Introduction  of  the  quantization  nonlinearity  fg(*) 
given  in  Eq.  (2.3-6)  in  the  measurement,  is  in  Eq.  (2.3  7). 
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requires  further  modification  of  the  estimation  algorithms 
given  in  Section  2.4.1.  The  approaches  used  to  deal  with 
this  effect  in  the  EKF  and  QKF  algorithms  are  quite  different, 
since  the  discontinuous  nature  of  the  nonlinearity  precludes 
the  formal  use  of  small  signal  linearization,  as  mentioned  in 
Section  A. 2, 


Observe  that  the  quantizer  characteristic  in  Eq. 
(2.3-6)  approaches  a continuous  linear  unity  gain  character- 
istic as  6 goes  to  zero  and  N goes  to  infinity.  This  implies 
that  quantization  can  be  ignored  in  the  limit  as  the  cell- 
width  6 becomes  small . and  we  can  replace  the  quantizer  with 
a unity  gain.  When  6 is  not  infinitesimal,  it  is  clearly 
not  reasonable  to  make  a formal  application  of  the  EKF 
principle  of  small-signal  linearization. 


9h  ~ 

h(x)  = h(^)  + g-  5 

x=St 


A T 

= h(^)+hgX 


since  the  fact  that  the  nonlinearity  has  zero  slope  for 
almost  all  values  of  the  input  would  lead  to  setting  hg 
to  be  zero.  A more  intuitively  satisfactory  linearization 
technique  entails  replacing  the  quantizer  with  a unity 
gain  (Ref.  4)  and  modeling  the  difference  between  the  input 
and  the  output  as  an  additive  white  quantization  noise,  v . 
If  the  quantizer  input  probability  density  function  is 
nearly  constant  over  each  cell,  then  it  is  accurate  to 
assume  that  v^  is  uniformly  distributed  over  the  interval 
-j6,  J6.  As  can  readily  be  established  (cf.  Table  C.2-1 
of  Kef.  5),  a random  variable  with  this  distribution  has 
y zero  mean  and  rms  level  of  6/^T2.  If  this  artificial 
random  process  is  assumed  to  be  uncorrelated  with  the  real 
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measurement  noise  sequence  in  Eq.  (2.3-3),  the  total 
measurement  noise  variance  is  then 


Pq  = Pv 


(2.4-12) 


Modifying  the  measurement  noise  variance  as  in  Eq.  (2.4-12) 
completely  accounts  for  the  effect  of  quantization  in  the 
small-signal  linearized  measurement  model. 


A quasi-linear  model  for  the  quantization  effect 
defined  in  Eq.  (2.3-6)  is  needed  for  the  QKF.  Given  the 
input  statistics, 


e£z3  = m 
E[(z-m)^]  « 


the  quasi-linear  representation  of  the  quantizer  is  of  the 
form 


fq(z)  5 f^(m,CT)  + nq(m,a)(z-m) 

The  ridf's  indicated  in  Eq.  (2.4-14)  are  (Ref.  3) 


(2.4-13) 


= . B)  - . .)] 

= i t ^ - ?)] 


(2.4-15) 


where 


ill 


1 -iv' 
PF(v)  e 


Iv)  =y*  ?F(v; 


(2.4-16) 
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From  the  quasi-linear  representation  of  the  noisy 
LOS  angle  measurement  before  quantization,  . (Eq.  (2.4-3)), 
the  quantizer  input  statistics  are  evaluated  approximately  as 


m = 8 
^ 


(2.4-17) 


The  complete  quasi-linear  measurement  model  is  then  obtained 
by  cascading  the  random  component  ridf's  as  follows: 


(2.4-18) 


The  two  linearized  measurement  models  described 
above  are  depicted  in  Fig.  2.4-1.  In  the  small  signal  or 
EKF  case,  the  addition  of  the  fictitious  quantization  noise 
(Eq.  (2.4-12))  to  the  model  given  in  Eq.  (2.4-1)  completely 
accounts  for  the  quantizer,  while  the  quasi-linear  repre- 
sentation of  the  same  effect  introduces  a describing  func- 
tion gain,  n^,  and  a modified  expected  value,  f^. 


On  the  basis  of  the  above  arguments,  the  EKF 
algorithm  modification  that  accounts  for  the  presence  of  LOS 
angle  quantization  is  obtained  by  merely  replacing  in 
Eq.  (2.4-9)  with  p given  in  Eq.  (2.4-12), 


iSw  = Pv  + « /12) 


(2.4-19) 


The  quasi-linear  model  of  Eq.  (2.4-18)  is  seen  to  result 
in  the  QKF  algorithm  having  measurement  update  equations  of 
the  form 


Xj^(  + ) = " fq(ro.P)) 

P,,c  + ) = [l  - n^(m,o)k,^h^(4(-),P,^(-))]p,^(-) 


(2.4-20) 


E \ 
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Figure  2,4-1  LOS  Angle  Measurement 

Quantization  Models 

where 

l^k  = (2.4-21) 

The  algorithms  given  in  this  section  for  estimating 
relative  missile-target  position,  velocity  and  acceleration 
arc  based  on  two  quite  general  and  powerful  nonlinear 
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estimation  techniques:  the  extended  Kalman  filter  (EKF)  and 

the  quasi-linear  Kalman  filter  (QKF).  The  goal  of  this 
study  is  to  determine  their  performance  (both  absolute  and 
comparative)  in  the  antishipping  missile  application 
(Fig.  1.1-1). 
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FILTER  RANGE  ESTIMATION  PERFORMANCE 


3.1  PRELIMINARIES 


a 

0 

u 

D 

y 

0 

a 

0 
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The  missile  from  which  the  target  line-of-sight  angle 
(LOS  angle)  measurements  are  taken  follows  a deterministic 
trajectory  which  is  qualitatively  depicted  in  Fig.  1.1-1.  The 
initial  7.2  sec  of  the  flight  is  a constant-altitude  cruise, 
with  normalized  altitude  of  unity  (y=l  unit)  and  an  initial 
horizontal  missile-target  separation,  Xq,  of  425  units.  The 
cruise  phase  of  the  engagement  ends  at  x=300  units  and  is 
followed  by  a pitch-up  maneuver.  The  latter  leads  to  a maxi- 
mum altitude  of  about  22  units  at  19  sec  and  terminates  at 
the  nominal  target  position  at  26.5  sec.  It  is  assumed  that 
the  motion  of  the  target  is  characterized  by  a horizontal 
acceleration  which  is  a zero-mean  correlated  gaussian  random 
process  with  bandwidth  0.05  rad/sec  and  rms  level  of 
3.22  ft/sec2;  these  parameter  values  are  representative  of  a 
moderately  large  ship  conducting  a slow  random  maneuver.  The 
LOS  angle  measurement  noise  sequence,  Vj^  in  Eq.  (2.3-3),  is 
always  assumed  to  be  a zero-mean  discrete  gaussian  process 
with  rms  level  4.38  mrad  (0.25  deg);  the  data  rate  is 
5 measurements/sec. 


1 1 In  order  to  assess  the  performance  of  the  various 

filter  algorithms,  a single  random  realization  of  the 
[■j  stochastic  nonlinear  estimation  problem  is  obtained.  Ran- 

dom  number  generators  are  used  to  generate  a suitable  mea- 
surement  noise  sequence,  Vj^,  and  random  target  accelera- 
iJ  tion  sample  function,  . In  all  of  the  engagements  pre- 

sented here,  the  time-histories  of  v,  and  a^  are  the  same, 

J] 
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which  permits  direct  comparison.  The  variables  of  greatest 
concern  are  the  initial  values  of  the  error  in  the  filter 
estimates,  Xq,  and  the  uncertainty  of  these  estimates,  Pq,  whe 


^ ^ x(0)  - x(0) 

^0  ] 


The  initial  state  vector  is  always  specified  by* 


x(0)  = 


425.3  u 
-17.90  u/sec 
1.0  u 
0.0  u/sec 
6.142  ft/sec2 


The  initial  estimation  error  covariance  matrix  is  assumed 
to  be  of  the  form 


J po  a- 

Xo  Xq  Xq 


po  a. 
^0  ^0 


pa  a.  0 
^0  ^0 


^0  ^0  ^0 


where  p is  chosen  to  be  0.707,  which  allows  for  correlation 
between  the  initial  velocity  and  position  estimates,  in  each 


♦The  abbreviation  u stands  for  unit  (normalized  length). 
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coordinate.  Thus,  Pq  is  completely  specified  by  the  five 
diagonal  elements,  or  their  square  roots.  For  convenient 
reference,  the  vector  Oq  is  defined  as  follows. 


Finally,  the  error,  f,  in  estimated  range,  and  the  estimate 
of  rms  range  uncertainty,"^  a^,  provided  by  the  filter  covari- 
ance matrix  are  of  particular  interest;  these  are  given  by 

r ^ r - r 

= /x2  + y2  _ /x2+y2 


2p 


i3^y  P33 


''2 « / . ^2  "'2 
y )/(x  +y 


(3.1-5) 


3.2 


MEASUREMENT  WITHOUT  QUANTIZATION 


The  filter  perfonnance  comparisons  presented  in  this 
section  are  for  situations  where  quantization  eflects  can  be 
neglected.  The  engagements  investigated  are  categorized 
according  to  the  assumed  value  of  the  initial  rms  horizontal- 
separation  estimation  error,  Ox  • 


♦Note  that  Oj.  is  not  the  true  rms  range  estimation  error 
because  the  filter  covariance  matrix  is  generally  not  equal 
to  the  actual  estimation  error  covariance  in  a nonlinear 
filtering  problem. 
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3.2.1  Small  Initial  rms  Horizontal-Separation 
Estimation  Error 


The  initial  values  of  x and  a are  specified  by 


-4.67 

u 

4.29 

u 

0.703 

u/sec 

0.707 

u /sec 

0.2 

u 

' ^ = 

0.209 

u 

-0.08 

u/sec 

0.0849 

u/sec 

6.142 

ft/sec^ 

3.22 

ft/sec^ 

These  conditions  correspond  closely  to  the  nominal  case  of 
Ref.  1 without  altimeter  measurements;  they  are  typical  of 
situations  where  radar  range  measurements  are  available  until 
the  filter  initialization  time,  when  they  are  denied  by  tar- 
get jamming  activity. 

The  time-histories  of  r,  the  range  estimation  error, 
and  the  rms  filter  range  uncertainty,  are  depicted  in 
Fig.  3.2-1.  Since  a is  much  smaller  than  x for  the  first 
10  sec  of  the  engagement,*  it  might  be  anticipated  that  the 
EKF  and  the  two  QKF  algorithms  should  perform  nearly  iden- 
tically, as  is  indicated  in  Fig.  3.2-1.  In  mid-engagement, 
however,  there  is  some  departure  between  the  EKF  and  the  QKF 
with  accurate  ridf's  determined  by  numerical  integration, 
denoted  QKF-N  (Sections  2.4  and  B.3).  Observe  that  the  QKF 
with  approximate  ridf's  based  on  a power  series  expansion 
(Section  B.2),  which  is  designated  QKF-P,  is  indistinguish- 
able from  the  EKF.  The  QKF  based  on  the  truncated  gaussian 
density  (QKF-T)  was  not  exercised  for  this  case;  as  shown 

♦Since  the  missile  altitude  is  always  much  smaller  than  the 
horizontal  missile-target  separation,  the  pairs  (x,r), 

(Ox* Or)  and  (x,f)  are  very  nearly  equal  in  the  studies  per- 
formed here. 
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Figure  3.2-1  Time-Histories  of  Range  Estimation 

Error  and  Uncertainty  for  Small 
Initial  Uncertainty 


subsequently,  its  performance  can  be  anticipated  to  be  inter- 
mediate to  that  of  the  QKF-N  and  the  QKF-P. 


The  relative  behavior  of  the  three  filter  algo- 
rithms directly  reflects  the  comparative  values  for  the 

A 

linearized  measurement  model  parameters  — 0 or  0,  h^^ , and 
h„  — listed  in  Table  2,4-1.  The  table  demonstrates  that 

«3 

corresponding  values  of  these  parameters  are  more  nearly 
equal  for  the  EKF  (small-signal  linearization)  and  the 
QKF-P  (power  series)  than  for  either  the  EKF  or  the  QKF-P 
and  the  QKF-N  (numerical  integration).  All  algorithms  main- 
tain and  r within  the  range  +12  units  for  the  trial  per- 
formed, which  may  be  adequate  in  some  circumstances,  espe- 
cially in  the  first  half  of  the  engagement  (t<15  sec)  when 
range  is  greater  than  180  units. 
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3,2.2  Large  Initial  rms  Horizontal-Separation 
Estimation  Error 


The  initial  rms  error  in  the  horizontal  separation 
estimate  was  increased  to  220  units,  to  represent  very  poor 
filter  initialization.  Five  initial  values  of  were  con- 
sidered, viz.,  225,  125,  25,  -75  and  -175  units,  which  are 
designated  Cases  x to  5,  respectively.  As  mentioned  pre- 
viously, fQ  = XQ,  since  y^  is  small.  Both  the  QKF-N  and  the 
EKF  were  exercised  for  all  initializations;  the  truncated 
gaussian  quasi-linear  algorithm,  QKF-T,  was  applied  to 
Cases  1,  3 and  5,  and  the  approximate  QKF-P  was  evaluated 
for  Cases  1 and  5.  Figure  3.2-2  depicts  the  simulation 
results. 


An  adverse  effect  observed  in  the  QKF-N  time  his- 
tories of  f is  a large  negative  step  change  at  the  time  the 
first  measurement  is  processed,  followed  by  a long  period 
of  relative  inactivity;  f changes  only  slightly  over  the 
first  ten  seconds  after  the  first  filter  update.  The  rea- 
son for  this  quiescent  behavior  is  clearly  evident  in  the 
corresponding  plots  of  The  filter  covariances  become 

so  small  that  subsequent  Kalman  gains  are  likewise  very 
small,  and  thus  the  corresponding  measurement  data  is  vir- 
tually ignored.  The  small  values  of  can  be  explained  by 
contrasting  the  initial  quasi-linear  measurement  equation 
parameters  (QKF-N)  with  those  obtained  by  small-signal 
linearization  (EKF),  as  given  in  Table  3.2-1  for  Case  1. 

A 

Based  on  Xq  and  o^q,  the  quasi-linear  representation 


0(x)  - 0(x,P)  + h«  (x-x)  + h_  (y-y) 


give:?  rise  to  values  of  0 and  h^  that  are  verv  large  in  corn- 
'll 

parison  with  the  corresponding  small-signal  linearization 
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(b)  filter  PERFORMANCE  CURVES  FOR  Iq  =•  125  UNITS  (CASE  2) 


Figure  3.2-2 


Time-Histories  of  Range  Estimation 
Error  and  Uncertainty  for  Large 
Initial  Uncertainty 
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(c)  FILTER  PERFORMANCE  CURVES  FOR Tq  = 25  UNITS  (CASE  3) 
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(d)  FILTER  PERFORMANCE  CURVES  F0R7q  = -75  UNITS  (CASE  4) 


Figure  3.2-2  Time-Histories  of  Range  Estimation 
Error  and  Uncertainty  for  Large 
Initial  Uncertainty  (Cont.) 
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Figure  3.2-2 


Time-Histories  of  Range  Estimation 
Error  and  Uncertainty  for  Large 
Initial  Uncertainty  (Cont.) 


TABLE  3.2-1 

COMPARISON  OF  MEASUREMENT  LINEARIZATION 
PARAMETERS,  CASE  1 


EKF 

QKF-N 

0(x)  = 0.00584  rad 

§ = 

0.573  rad 

= -6.31x10"' 
Si 

hQi 

= -7.72x10"^ 

h„  = 1.02x10"^ 

S3 

= 8.56x10"^ 

parameters  0(x)  and  • In  the  filter  update  equation 
for  the  QKF-N,  Eq.  (2.4-10),  the  large  0 and  hq^  values 
result  in  a large  change  in  x and  in  the  (1,1)  element  of 
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(I-k.^)  being  very  small;  this  greatly  reduces  after  the 
first  update.  The  behavior  of  the  QKF-N  described  above  is 
clearly  inappropriate  in  Cases  1,3,4  and  5;  for  Case  2,  the 
apparent  superiority  of  the  QKF  is  "accidental,"  in  that  the 
large  step  change  in  f just  happens  to  be  nearly  "correct." 

The  QKF-P  behaves  somewhat  like  the  QKF-N  in  Case  1. 
An  abrupt  initial  change  occurs  in  f,  followed  by  small 
variations.  Since  for  the  QKF-P  is  larger  than  for  the 
QKF-N,  the  QKF-P  takes  advantage  of  the  additional  angular 
information  provided  by  the  pitch-up  maneuver  sooner  than 
the  QKF-N,  achieving  a smaller  value  of  f after  10  sec.  In 
Case  5,  the  QKF-,:"  is  much  closer  to  the  EKF  in  performance. 
This  is  attributed  to  the  fact  that  is  much  larger  than 


for  this  case  (by  a factor  of  3),  resulting  in  a smaller 
difference  between  quasi-linearization  (particularly  in  the 
ower  series  approximation)  and  small-signal  linearization, 

*s  shown  in  Fig.  B.3-2. 

The  QKF-T  was  conoidered  in  this  study  to  investi- 
gate the  impact  of  using  alternative  densities  for  x.  The 
truncated  gaussian  density,  Eq.  (2.4-5),  was  used  in  the 
numerical  integration  arctangent  describing  function  sub- 
routine (Section  B.3)  as  the  basis  for  describing  function 
evaluations.  It  appears  tnat  the  truncation  of  the  density 
improves  the  QKF  significantly  for  large  positive  initial 
range  estimation  errors  (Fig.  3.2-2a),  but  that  performance 
for  small  or  large  negative  values  of  the  initial  estimation 
error  is  not  better  than  the  EKF  in  the  same  circumstances, 
•’as,  while  modifying  the  density  function  p(x)  upon  which 
.he  quasi-linear  filter  is  based  does  remove  one  deficiency 
of  the  gaussian-based  QKF  — the  large  initial  step  change 
in  r and  ensuing  10  sec  period  of  quiescent  behavior  discussed 
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above  — it  does  not  appear  that  the  QKF  methodology  is 
significantly  superior  to  the  simpler  EKF  algorithm  in  this 
applicat ion . 

All  filter  algorithms  appear  to  be  more  effective 
for  f>0,  i.e.  for  initial  filter  estimates  of  range  that 
are  smaller  than  the  actual  value.  This  result  can  be 
explained  by  the  geometry  of  the  situation;  The  arctangent 
nonlinearity  and  its  slope  become  very  small  as  x increases, 
which  implies  that  it  becomes  more  difficult  to  distinguish 
negative  horizontal-separation  estimation  errors  (x<x)  than 
positive  ones  of  the  same  magnitude. 

Of  the  algorit'nms  considered,  the  QKF-N  is  the 
least  effective,  especially  during  the  cru?se  phase.  This 
is  attributed  to  unrealistically  small  values  of  o (or, 
equivalently,  small  values  of  — Fig.  3.2-2)  after  the 
first  measurement  is  processed.  Considering  the  remaining 
filters,  there  does  not  appear  to  be  a clear-cut  advantage 
to  any  single  algorithm.  The  EKF  appears  to  have  a band- 
width that  is  too  wide,  as  may  be  deduced  from  the  presence 
of  large  error  "spikes"  (at  t = 9 sec,  for  example).  The 
QKF-T  and  the  approximate  QKF-P  are  in  some  senses  compromises 
between  the  EKF  and  the  QKF-N  (refer  to  Figs.  3.2-2  and 
B.3-2);  they  do  not  seem  to  offer  any  compelling  advantages 
over  the  EKF  for  the  cases  studied,  however.  Because  of 
the  divergence  for  small  values  of  x exhibited  by  the  power 
series  quasi-linear  term,  6p  (shown  in  Fig.  B.3-2),  it  might 
be  inadvisable  to  use  the  QKF-P  design. 
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3.2.3  The  Cram4r-Rao  Inequality 

The  studies  discussed  in  Sections  3.2.1  and  3.2.2 
indicate  that  the  QKF  methodology  is  not  significantly  superior 
to  the  EKF  in  the  present  application.  This  result  was  not 
anticipated  since  quasi-linearization  generally  provides  a 
more  realistic  representation  of  a nonlinear  effect  than 
small-signal  linearization,  which  should  result  in  obtaining 
a more  effective  filter  algorithm.  However,  there  is  a clear- 
cut  explanation  for  the  unexpected  results  in  this  investi- 
gation: The  EKF  appears  to  be  quite  effective  in  comparison 

with  the  "best  that  can  be  done"  in  the  situation  considered. 

The  Cram6r-Rao  inequality  (Ref.  7)  provides  an 
absolute  reference  for  judging  the  performance  of  a filter 
algorithm  in  solving  a nonlinear  estimation  problem.  Based 
on  the  system  and  measurement  models,  and  on  the  initial 
statistics  of  the  estimation  error,  this  inequality  provides 
a lower  bound  on  the  rms  estimation  error  that  is  the  best 
that  can  be  achieved  by  any  algorithm.  In  general  terms,  if 
x(z)  is  an  unbiased  estimate  of  the  quantity  x,  which  is  based 
on  a noisy  measurement,  z,  then  a fairly  straightforward  appli- 
cation of  the  Schwarz  inequality  leads  to  a lower  bound  on 
the  variance  of  the  estimation  error, 

E[(x(z)-x)2]  > 1/E[01n  p(z|x)/9x)^] 

The  function  p(z|x)  is  the  conditional  probability  density 
function  (pdf). 


p(z|x)  = p(x,z)/p(x) 


where  p(x)  and  p(x,z)  are  the  pdf  of  x and  the  joint  pdf  of 
X and  z,  respectively.  The  Cramdr-Rao  inequality  is  useful 
for  determining  whether  a given  algorithm  is  comparable  in 
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performance  to  the  unspecified  optimal  algorithm,  and  thus, 
whether  it  is  fruitful  to  attempt  to  design  a "more  sophis- 
ticated" filter  for  the  same  problem. 


The  result  shown  in  Fig.  3.2-3  demonstrates  the 
application  of  the  Cramdr-Rao  lower  bound  to  a scenario 
that  is  similar  to,  but  slightly -simpler  than,  the  engagement 
studied  in  Section  3.2.2.  Pq  in  Eq.  (3.1-3)  is  specified 
by  setting  the  correlation  coefficient  p to  zero  and  choosing 


£q  to  be 


^0  = 


'220.0 


0.707  u/sec 
0.209  u 
0.0  u/sec 

0.0  ft/sec2 


Thus  the  target  acceleration  and  altitude  rate  rms  levels 
are  neglected  in  this  case.  Furthermore,  since  range  esti- 
mation in  the  cruise  phase  is  of  particular  interest,  the 
pitch-up  missile  maneuver  is  suppressed;  the  altitude  y 
satisfies 


y(t)  = 1 unit 

during  the  entire  engagement. 

For  comparison  purposes,  the  EKF  is  used  to  estimate 
range  in  the  same  circumstances.  The  particular  initial  con- 
dition considered  in  obtaining  the  results  in  Fig.  3.2-3  is 


225.0 


0.703  u/sec 

0.2  u 

0.0  u/sec 

0.0  ft/sec^ 
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Figure  3.2-3  Application  of  the  Craxn4r-Rao 

(C-R)  Inequality  to  the  Range 
Estimation  Problem 


and  the  measurement  noise  sequence,  Vj^,  is  the  same  as  in 
all  previous  cases.  Since  the  EKF  range  estimation  error, 
f,  is  well  within  the  Cramdr-Rao  lower  bound  on  rms  range 
estimation  error  over  most  of  the  trajectory,*  it  may  be 
inferred  that  the  EKF  is  quite  effective  for  the  range 
estimation  task  treated  in  this  study. 


3.3  THE  QUANTIZED  MEASUREMENT  CASE 

The  study  of  quantization  in  the  LOS  angle  measure- 
ment was  performed  for  the  scenario  treated  in  Section  3.2.1, 
where  the  initial  range  estimation  error  and  rms  filter 
range  uncertainty  are  small  (-4.67,  4.29  units  respectively). 
The  QKF  models  the  quantizer  with  a random-input  describing 
function  that  takes  into  consideration  the  exact  form  of  the 


♦The  Cramer-Rao  lower  bound  is  statistical  in  nature;  i.e., 
f for  any  specific  trial  may  be  less  than  the  Cram^r-Rao 
lower  bound  on  rms  range  estimation  error,  as  in  Fig.  3.2-3. 
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nonlinearity  and  the  statistics  of  the  quantizer  input,  while 
the  EKF  accounts  for  the  effect  by  the  art if ace  of  introduc- 
ing a "fictitious  quantization  noise"  of  suitable  rms  level. 
The  measurement  models  upon  which  the  EKF  and  QKF  algorithms 
are  based  are  portrayed  in  Fig.  2.4-1.  The  three  cases  con- 
sidered in  this  investigation  are  specified  by  quantizer  level 
increments,  6,  of  0.5,  1.0  and  2.0  degrees.  The  number  of 
positive  and  negative  levels,  N,  is  40,  20  and  10,  respec- 
tively, so  that  quantizer  saturation  occurs  at  ±20  degrees 
in  each  instance. 


The  small  quantization  increment,  0.5  deg,  leads  to 
the  filter  performance  curves  depicted  in  Fig.  3.3-1.  The 
filter  algorithms  applied  to  this  problem  were  the  EKF  and 
the  QKF-N.  During  the  cruise  phase,  t < 7.2  sec,  the  per- 
formance curves  are  essentially  identical  to  those  obtained 
without  quantization.  Fig.  3.2-1.  This  behavior  is  to  be 
expected,  since  the  LOS  angle  is  less  than  0.25  deg  over  this 
period,  and  the  measurement  noise  is  sufficient  to  mask  the 
effect  of  the  quantizer.  Beyond  10  sec,  both  the  QKF  and  EKF 
curves  aro  displaced  positively  with  respect  to  the  corres- 
ponding range  estimation  curves  obtained  without  quantiza- 
tion. The  peak  EKF  range  estimation  error  of  11  units  at 
16  sec  is  twice  that  shown  in  Fig.  3.2-1  at  the  same  time, 
and  the  negative  peak  in  f for  the  QKF-N  at  14  sec  is  reduced 
from  -12  units  (without  quantization)  to  -6  units  in  the 
present  case.  The  reason  for  this  apparent  offset  is  not 
clear;  extensive  monte  carlo  simulation  would  be  required  to 
determine  if  biases  due  to  quantization  are  present.  Com- 
paring the  results  in  Figs.  3.2-1  and  3.3-1  (the  former  cor- 
responding to  the  same  .scenario  without  quantization),  there 
does  not  seem  to  be  any  basis  for  a judgment  concerning  the 
relative  statistical  performance  of  the  two  filter  algorithms 
with  or  without  Quantization  present. 
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Figure  3.3-1  Range  Estimation  Algorithm  Per- 
formance With  One-Half  Degree 
LOS  Angle  Quantization 


The  filter  performance  curves  for  quantizer  incre- 
ments of  1 and  2 deg  are  given  in  Fig.  3.3-2.  Three  filter 
algorithms  were  used  in  these  studies,  the  EKF,  QKF-N 
and  QKF-T;  observe  that  the  QKF-T  was  indistinguishable 
from  the  QKF-N  in  its  behavior  in  both  cases.  Very  much 
the  same  behavior  is  observed  as  in  Fig.  3.3-1,  in  that 
the  first  7.2  sec  of  the  engagement  still  results  in  an 
unchanged  time  history  of  r,  and  the  QKF  curve  is  generally 
displaced  below  the  EKF  curve  of  f thereafter. 


3.4  SUMMARY 

The  material  presented  in  this  chapter  gives  an 
indication  of  the  range  tstimation  capability  of  two  types 
of  filter  algorithms,  for  engagements  representing  a tac- 
tical missile  intercepting  a surface  target  after  a cruise 
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(constant  altitude)  phase.  While  the  design  principles  of  the 
filter  algorithms  are  quite  different,  the  EKF  being  derived 
from  small-signal  linearization  and  the  QKF  being  based  on 
quasi-linearization,  their  performance  is  quite  comparable 
for  small  estimation  errors  (Section  3.2.1).  As  the  mean  and 
rms  initial  estimation  errors  are  increased,  the  behavior  of 
the  range  estimates  becomes  very  dissimilar,  especially  when 
the  initial  estimate  is  small  compared  to  the  true  value. 
However,  it  is  difficult  to  make  a case  for  the  superiority 
of  either  algorithm  based  on  the  limited  number  of  monte  carlo 
simulations  that  have  been  performed. 
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triie  uncertainty,  o^.  The  prenentatlon  loi  thin  cane  Ips  con 
.'  iiHled  with  a dlecuaeioh  of  a eleeely-relfited  subsidiary 


1 nvostlgattort  an  application  of  tho  Cr»mdr~Rao  Ine^juality 
to  a simplified  intercept  scenario.  Tho  latter  study  estab- 
lishes the  lower  bound  on  range  estimation  error  that  can  be 
achieved  by  any  algprtthm  for  the  problem  considered.  It  thus 
rrovldos  a basis  for  aseeaslng  tho  performance  of  tho  various 
!, ig'irithms  In  the  sane  case.  Thc^  chapter  concludes  with  a 
divcufision  of  the  effect  of  quantization  for  three  quantizer 
I o V© 1 1 ncremen  t« . 


4.2  CONCLUSIONS 


From  the  simulation  results  presented  In  this  report, 
it  appears  that  the  gausslao  QKF  with  numerical  integration 
(i.e.,  tho  QKP-N  algorithm  with  describing  functions  for  the 
arctangent  measurement  nonlinearity  based  on  the  gaussian 
« (CTumptlon)  performs  poorly  when  Initial  range  estimate  errors 
and  rms  uncertainties  are  large  (Ooction  3.2.2).  In  such 
canon,  tho  filter  makes  one  large  initial  correction  to  the 
rang«»  ostlmale,  and  then  almost  completely  iguorcn  subsequent 
fnaaetjrement  data  during  the  crv.ls©  phase,  a«  illustrated  in 
Fig.  3,2-2.  This  problem  1»  due  to  tho  gauss Ian  aesumptioa;  the 
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The  Criu»4r-*ltoo  lowei  bound  on  rms  oatlmatlon  error 
that  can  be  achieved  by  algorithm  (applied  to  the  cruise 
r hime  of  the  oiiosloa  ih  the  large  initial  range  uncertainty 
'.  ajfjf?,  as  reported  la  Section  3.2.3)  Indicates  that  the  BKF 
nearly  as  vail  aa  possible.  If  this  la  true,  then 
the  failure  of  any  (SKF  to  outperform  the  EKF  Is  due  to  the 
fact  that  the  BKF  is  well-suited  for  the  present  filtering 
laKk;  thus  it  may  not  be  worthwhile  to  seek  more  sophisti- 
cated filter  algorlthias  (e.g.  modified  QKF’s)  for  the 
cppllcati:>n  considered  here. 

A second  factor  contributing  to  the  Inability  of 
trtc  QKP  methodology  to  putporform  the  BKF  design  technique 
in  this  application Jla  that  statistical  linearization  can 
\h)  sfory  sensitive  to  tho  assumptions  made  regarding  the  Joint 
t»robabltlty  deneicy  function  of  the  system  state  variables 
(Rcfo.  5.C>.  This  problem  la  especially  acute  in  dealing 
nonllnearltlc/s  ouch  as  arctangent (y/x)  which  exhibit 
iargc  changofl  for  small  changes  in  input  --as  happen?!  her 
cr  K « 0.  This  sensitivity  in  clearly  demonstrated  in  the 
K'i  forwif»ac®  of  the  Okr-K  and  QKP-T  (Fig.  3.2-2).  It  is 
rocHible  that  a more  effective  QKF  algorithm  could  be 
fonnd  based  on  other  Joint  probability  dennlty  functioiJs. 
Uoaever,  the  Cramdr-Bao  result  outlined  above  makes  it 
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^:n.-btfu,l  tislfci  tb#  p^fOMBauftc©  ^in«  obtained  in  this  wa;' 
v^,.>uitl  h&  Yeyy  sigllifiWnt...  . ' ' 

The  treaisHiftt  oi  quantlxuition  (Sectlott  3.3)  leadw 
■..:>  donolusion®  tJii.t'- <Mf«  olotlar  to  thoB®  (ilscu«ai«d  abov®. 

is,  there  doBs  -ilot  appear  to  ■!>«  perXomance  advantages 
I nisareat  in  any  of  the  filter  de«tgn  techaiquos  cotiBldered. 
ixtensive  monte  carlo  analyoeii  of  all  filter  algorithms  is 
nit  ded  to  make  a oiorB  definite  co«parl«on. 

Tne  fact  that  the  QKF  approach  did  not  appear  to 
lead  to  algorlthBiB  which  perform  Bignif icantly  better  than 
the  E33P  for  the  pgoMeto  considered  in  this  report  should  not 
be  Interpreted  to  be  a general  crltlciein  of  this  applica- 
tion of  describing  function  techniques.  It  It*  reasonable  to 
ojipect  that  there  are  applications  In  which  the  QKF  will 
excel , In  a considerably  simpler  nonlinear  estimation 
problem  (Refs.  2 and  8),  definite  performance  advantages  of 
the  QKF  were  observed.  The  results  presented  In  this  docu- 
ment provide  a basis  for  further  research  in  this  area,  and 
:;^ive  eom©  insight  into  problem  areas  thtt  might  bo  encoun- 
tered and  methods  of  dealing  with  them. 
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APPENDIX  A 

OUTLINE  OF  NONLINEAR  FILTERING  THEORY 


The  equations  of  the  optimal  (Kalman)  linear  filter 
and  of  several  modified  Kalman  filters  for  the  nonlinear 
case  for  estimating  the  states  of  continuous  systems  using 
discrete  noisy  measurement  data  are  reviewed  briefly  in 
this  appendix.  The  extended  Kalman  filter  and  quasi-1 inear 
Kalman  filter  are  suboptimal  generalizations  of  the  optimal 
linear  filter,  and  are  applicable  to  systems  which  contain 
significant  nonlinear  effects  such  as  those  encountered 
in  the  range  estimation  problem  studied  in  this  report. 

This  appendix  provides  the  background  and  notational  con- 
ventions needed  for  understanding  the  algorithms  applied 
in  this  study;  a basic  familiarity  with  random  variables 
and  state  space  notation  is  assumed.  Additional  detail 
can  be  found  in  Ref.  2. 

A.l  KALMAN  FILTER  EQUATIONS 

To  apply  Kalman  filtering  to  any  estimation  prob- 
lem, it  is  necessary  to  derive  a linear  stochastic  first- 
order  vector  differential  equation  to  model  the  system,  of 
the  form 

x(t)  = F(t)x(t)  + G(t)w(t)  + L(t)u(t)  (A. 1-1) 

where  x(t)  is  an  n><l  column  vector  representing  the  system 
state,  and  F(t)  is  an  nxn  dynamic  matrix  which  defines  the 


A-1 


interaction  of  the  state  vector  components.  The  vector 
w(t)  is  a pxl  column  vector  of  white  gaussian  noise  inputs, 
specified  by  a zero  mean  and  the  spectral  density  matrix*  Q, 

= 0 J E[w(t)w(T)'^3  = Q(t)6(t-T) 

and  the  matrix  G(t>  is  an  nxp  distribution  matrix  which 
indicates  how  <=*ach  component  of  w(t)  affects  each  component 
of  the  system  state  derivative.  The  variable  u(t)  is  an  mxl 
column  vector  of  known  system  inputs,  which  are  allocated 
Lo  the  state  differential  equations  by  the  nxm  matrix  L(t). 

In  the  missile-target  range  estimation  problem  considered 
here,  the  compone....s  of  the  state  vector  x include  position 
and  velocity  variables  plus  target  acceleration.  Note 
that  F,  G,  L and  Q matrices  may  be  time-varying;  in  sub- 
sequent development  the  explicit  notation  (t)  will  be 
omitted. 

At  discrete  instan+s  of  time,  tj^,  measurements  of 
linear  combinations  of  the  state  variables  are  made.  The 
equation  describing  this  measurement  process  has  the  general 
form 

?-k  ' "k2k  * 2k 

where  is  a vector  of  r measured  quantities  at  time  tj^,  Hj^ 
is  an  rxn  observation  matrix  describing  the  linear  combinations 
of  state  variables  which  comprise  z^  in  the  absence  of  noise, 
and  Vj^  is  an  r-vector  of  zero-mean  gaussian  measurement  errors 
with  a covariance  matrix,  Rj^,  defined  by^ 

♦The  symbol  6(t-r)  denotes  the  Dirac  delta  function. 

■f'The  symbol  is  the  Kronecker  delta;  it  is  unity 
for  j=k  and  zero  otherwise. 
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The  objective  of  optimal  estimation  theory  is  to 
process  the  measurements  in  real  time  and  produce  an  esti- 
mate ^(t)  of  the  system  state  x(t)  having  minimum  error,  in 
some  statistical  sense.  The  optimization  criterion  most 
often  chosen  is  that  of  minimizing  the  mean  square  estimation 
error.  This  estimate  is  calculated  with  the  Kalman  filter- 
ing algorithm. 

As  each  new  measurement  becomes  available,  there 
is  essentially  an  Instantaneous  change  in  the  knowledge 
of  the  state  x(tj^).  Denoting  the  optimum  estimate  of 
x(tjj)  just  prior  to  the  availability  of  Zy.  as  and 

the  optimum  estimate  of  the  state  vector  immediately  after 
processing  Zj^  as  the  Kalman  filter  generates  the 

optimum  estimate  of  the  system  state  according  to  the 
following  algorithm: 

^(t)  = F^(t)  + Lu(t)  ; ' ^k-1  - ^ 

(A. 1-3) 

^ ^kC^k  - (A.1-4) 

Equation  (A. 1-3)  is  used  to  propagate  the  estimate  between 
measurements,  and  Eq.  (A. 1-4)  is  used  to  update  the  estimate 
when  new  data  is  received. 

The  n^r  matrix  Kj^  in  Eq.  (A.  1-4)  is  the  Kalman 
gain  matrix,  which  is  obtained  from  the  estimation  error 
covariance  matrix,  P,  as  follows: 

-k  " “k^'^  (A.  1-5) 
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X 


The  matrix  P satisfies  the  propagation  and  update  equations 
given  in  Ref.  2 as 


P(t)  = FP  + PF*^  + GQG*^  , tj^_^  ^ t ^ ty. 


(A. 1-6) 


These  relations  complete  the  outline  of  the  Kalman  filter 
design  for  linear  systems. 


A. 2 THE  EXTENDED  KALMAN  FILTER  FOR  NONLINEAR  ESTIMATION 

Optimal  linear  estimation  theory  provides  a power- 
ful analytical  tool  for  analyzing  and  synthesizing  filter 
algorithms  when  the  system  equations  of  motion  and  measure- 
ment equations  are  linear.  However,  the  range  estimation 
problem  contains  at  least  one  inherent  nonlinear  effect 
which  may  be  sufficiently  important  to  warrant  the  use  of 
a nonlinear  estimation  technique.  This  effect  is  the  LOS 
angle  or  bearing  measurement  provided  by  the  target  track- 
ing system  sensor,  which  is  a nonlinear  function  of  rela- 
tive missile-target  position  in  Cartesian  coordinates. 
Whenever  nonlinearities  are  not  negligible,  a data  pro- 
cessing algorithm  derived  from  the  principles  of  non- 
linear estimation  theory  may  yield  considerably  better  esti- 
mates than  a linear  (or  linearized)  Kalman  filter.  This 
section  discusses  the  extended  Kalman  filter  used  in  this 
report  as  one  solution  to  the  nonlinear  range  estimation 
problem. 


A quite  general  mathematical  model  for  nonlinear 
stochastic  systems  is  given  by  the  equations 

*(t)  = f(x(t),t)  + G(t)w(t)  + L(t)u(t)  (A. 2-1) 

^1,  = Zv  • ^ = 1,2,...  (A. 2-2) 
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where  f and  are  nonlinear  differentiable*  functions  of 
the  state  vector  x,  w(t)  and  Vj^  are  zero  mean,  independent 
gaussian  white  noise  processes  having  spectral  density 
and  covariance  matrices  Q(t)  and  Rj^,  respectively,  and  u is 
a vector  of  known  inputs.  Assume  as  before  that  measure- 
ments are  taken  at  discrete  times  tj^. 


The  first  approach  one  might  use  to  derive  a 
filtering  algorithm  for  x(t)  in  Eq.  (A. 2-1)  is  to  linearize 
the  nonlinear  functions  f and  hj^  about  an  appropriate  known 
reference  trajectory  x(t)  and  then  apply  conventional  optimal 
linear  estimation  theory  — i.e.,  the  Kalman  filter  discussed 
in  the  last  section.  Thus,  denoting  x(tj^)  by  Xj^,  the  so- 
called  small -signal  linearization  procedure  results  in  the 
expressions 


^(x,t)  = f(x,t)  + 


8f 

lx 


(X-x) 


x=x 


= f(x,t)  + F(x,t)(x-x) 


(A. 2-3) 


3hk 

-k^-k^  " -k^-k^  IxT 

— k 


<5k-^k> 


^k”ik 


(A. 2-4) 


♦Note  that  differentiability,  as  required  in  Eqs.  (A. 2-3)  and 
(A. 2-4),  precludes  the  formal  application  of  the  present 
technique  to  systems  with  nonlinearities  such  as  the  limiter 
and  the  quantizer  which  do  not  have  derivatives  everywhere. 
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H which  may  be  substituted  into  Eqs.  (A. 2-1)  and  (A. 2-2)  to 

derive  the  corresponding  Kalman  filter  which  estimates  the 
m variation  in  x,  ^(t)  ^ x(t)  » x(t),  from  the  reference 

■ trajectory.  When  the  reference  trajectory  is  chosen  to  be 

_ the  current  best  estimate  of  the  state  x(t),  the  resulting 

I algorithm  is  known  as  an  extended  Kalman  filter  (EKF);  the 

mechanization  equations  for  the  latter  are  given  in  Table 
I A. 2-1  (Ref.  2). 

TABLE  A. 2-1 

■ SUMMARY  OF  THE  DISCRETE /CONTINUOUS 

■ EXTENDED  KALMAN  FILTER  ALGORITHM 


Systea  Model 

X - f(x,t)  ♦ 6(t)w(t)  ♦ L(t)u(t): 

t[*(t)*^(T)]  - Q(t)«(t-t) 

Neaeureaent  Model 

• Vjk 

laitiel  Conditions 

Other  Asstuaptlons 

■ 0 for  all  k and  all  t 

u(t)  Is  a kaoaa  input  vector 

State  Estlaate 
Extrapolation 

* - f(k,t)  ♦ L(t)u(t)  ; - ijt. 

!<♦> 

Error  Covariance 
Extrapolation 

^ - F(*,t)P  + PP'*'(k.t)  + 0(t)Q(t)G'^(t)  ; 
P<Vl>  - **k-l<^> 

State  Estlaate  Update 

»»(♦>  - »»<->  * «,[s»  - 5i.<Si.'-»] 

Error  Covariance  Update 

Pk<*)  - 

Gala  Matrix 

'(«•*>  ‘ -li— 

Definitions 

X"X 

Sk  - «»<-> 
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As  long  as  the  linearization  in  Eq.  (A. 2-4)  is 
accurate,  the  filter  algorithm  will  give  nearly  optimal  per- 
formance. Experience  with  similar  ranging  problems  indi- 
cates that  the  EKF  is  an  adequate  subopt jjnal  estimation 
technique  in  applications  in  which  estimation  error  is  small. 


I 

I 


A. 3 THE  QUASI-LINEAR  KALUAN  FILTER  FOR  NONLINEAR  ESTIMATION 

As  in  the  previous  section,  the  general  mathematical 
model  is  assumed  to  be  of  the  form  indicated  in  Eqs.  (A. 2-1) 
and  (A. 2-2),  with  the  removal  of  the  restriction  that  f and 
h must  be  differentiable.  The  point  of  departure  is  the 
method  of  linearization:  Rather  than  assuming  that  estimation 

error  is  "small"  in  some  sense  and  making  use  of  the  small- 
signal  linearization  technique,  it  is  assumed  that  the  esti- 
mation error  vector  x is  a zero-mean  gaussian  random  vari- 
able with  covariance  P,  and  the  nonlinearities  in  the  model 
are  replaced  with  their  approximate  random-input  describing 
function  (ridf)  representations.  The  quasi-linear  analogs 
to  the  approximations  in  Eqs.  (A. 2-3)  and  (A. 2-4)  are 


f(x,t)  = f(x,P,t)  + Nj(x,P,t)(x-x) 

hj,(Xk(-))  = 

(A. 3-1) 


where 


f(x.P,t)  ^ |^(2ii)**|p|j  y****y* l<x.t)exp|-ix'^p'^x  ^dxj^dxg. . .dXjj 


Nj(x,P,t)  ^ |^(2it)**|p|J  i(x,t)exp|-jx^^p~^xjp"^x  dx^dXg. . .dx^^ 


(A. 3-2) 


A-7 


THE  ANALYTIC  SCIENCES  CORPCnATION 


and  the  arrays  hj^,  Nj^  are  defined  in  a similar  way  with 
hj^  substituted  for  ^ in  Eq.  (A. 3-2). 

For  further  details  on  the  above  statistical 
linearization  procedure,  see  Refs.  3 and  5.  In  the  present 
context,  it  suffices  to  observe  that  the  gaussian  assump- 
tion guarantees  that  the  ridf  arrays  in  Eq.  (A. 3-1)  are 
functions  only  of  x,  P and  t,  as  the  notation  suggests. 

For  small  estimation  error  (for  P small),  the  quasi-linear 
approximation  approaches  small-signal  linearization;  when 
the  deviation  of  x from  x is  not  insignificant,  then  P pro- 
vides the  statistical  measure  ("amplitude")  of  this  deviation, 
and  the  ridf  representations  of  f and  h are  dependent  on 
this  amplitude  in  a way  which  captures  the  nonlinear  effect 
much  more  faithfully  than  the  small-signal  linearized  model. 

The  use  of  the  quasi-linear  approximations  indicated 
in  Eqs.  (A. 3-1)  and  (A. 3-2)  as  the  basis  fur  a modified  Kal- 
man filter  algorithm  leads  to  the  quasi-linear  Kalman  filter 
(QKF).  The  equations  are  directly  analogous  tc  those  given 
in  Table  A. 2-1  with  the  following  substitutions: 


f(^,t) 

|(x,P,t) 

F(x,t)  -*■ 

Nf(x,P,t) 

hj,(Xj^(-))  - 

h(Xk(-).Pk(-)) 

»k 

The  algorithm  obtained  by  making  the  changes  indicated  in 
Eq.  (A. 3-3)  in  Table  A. 2-1  completes  the  development  of  the 
QKF. 
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APPENDIX  B 

RANDOM- INPUT  DESCRIBING  FUNCTIONS  FOR  THE  RANGE 
ESTIMATION  MEASUREMENT  NONLINEARITIES 


B.l  INTRODUCTION 


B 

0 

O 

0 

fl 

B 

n 

11 


Two  nonlinearities  are  treated  in  this  investigation: 
tan~^(y/x),  which  is  encountered  in  expressing  LOS  angle 
(target  bearing)  in  terms  of  missile-target  separation  in 
Cartesian  coordinates,  and  f^(z),  or  the  quantizer  defined 
in  Eq.  (2.3-6).  The  quasi-linear  representation  of  the 
quantizer  (Eqs.  (2.4-13)  to  (2.4-15))  is  a well-known  result, 
so  it  is  not  presented  here  (cf.  Ref.  3),  The  arctangent 
nonlinearity  has  not  been  treated  extensively  prior  to  this 
study  (refer  to  Ref.  6 for  a preliminary  approximate  approach), 
so  it  is  considered  in  some  detail. 

The  random-input  describing  function  (ridf) 
approximation  sought  is  of  the  form 

0(x,y)  ^ tan”^(y/x) 

s 0 + n^^(x-^i)  + Uy(y-y) 

^ § + n*^(x-x)  (B.1-1) 

where 


I 


x*^  = tx  y] 

x*^  ^ (x  yl 

6 ^ El0(x)] 

n*^  ^ E[0(x)(x-x)'^]P"^ 
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(B.1-2) 
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1 


Q 

D 

D 

fl 

D 

Q 

3 


i 


I 


and  it  is  assumed  that  the  vector  x is  gaussian  with  mean,  x, 
and  covariance,  P,  given  by 


P » e|^(x-x)(x-x)'^J 


^xx  ^xy 
Pxy  Pyy 


(B.1-3) 


The  evaluation  of  n is  simplified  under  the  gaussian  assump- 
tion (Ref.  5)  to  be 

rp  A 

n . ^ (B.1-4) 

3x 

However,  the  integral  required  in  evaluating  6,  as  speci- 
fied in  Eq.  (B.1-2),  i.e.. 


9 


1 

2tTJpP 


(y/x) 


exp|-i  ( x-x  )^P””^  ( x-x  )|  dxdy 

(B.1-5) 


cannot  be  performed  analytically  to  yield  a closed-form 
solution,  so  other  approaches  to  evaluating  Eq.  (B.1-2)  are 
required. 


B.2  AN  APPROXIMATE  QUASI-LINEAR  REPRESENTATION 
OF  ARCTAN(y/x) 

A technique  that  gives  rise  to  approximate  ridf's 
for  use  in  Eq.  (B.1-1)  is  based  on  the  series  expansion  of 
the  nonlinearity.  In  general,  given 
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f(x) 


f(x)  + H (X-S)  * II  (y-y) 


2 

<x-it)^  + 2 (x-it)(y-y) 


- ^ (y-?)" 

3y 

^ X“X 


+ higher  order  terms 


the  expectation  operation  yields 


(B.2-1) 


E(f(x)l 


/xy 

x=x  x=*x 


+ higher  order  terms 


(B.2-2) 


If  the  elanents  of  P are  not  large  with  respect  to  x and  y 
(i.e.,  if  the  estimation  error  uncertainty  is  small  in  com- 
parison with  the  estimates  of  missile-target  separation),  then 
a useful  approximation  is  obtained  by  omitting  the  higher 
order  terms  in  Eq.  (B.2-2).  For  arctan(y/x)  this  leads  to 

e = 0p  = tan  ^(y/x)  + IxyCp^^^^-p^y)  - Pj^y(x^  - y'^)] /(x^+y“)^ 

(B.2-3) 


B-3 


THE  ANALYTIC  SCIENCES  CORPORATION 


Observe  that  substituting  the  first  term  of  Eq. 
(B.2-3)  into  Eqs.  (B.1-2)  and  (B.1-4)  yields  the  small-sig- 
nal linearization  approximation  given  in  Eq.  (2,4-1), 

(y-y)  (B.2-4) 

x=x 

The  second  term  in  Eq.  (B.2-3)  represents  the  first  correction 

term  which  accounts  for  the  estimation  error  uncertainty. 

This  approximate  expression  for  6,  and  the  approximate 

values  of  n and  n obtained  by  applying  Eq.  (B.1-4),  should 
X y 

quite  accurately  represent  the  amplitude-dependent  nature  of 
the  arctangent  nonlinearity  in  cases  where  rms  estimation 
uncertainty  is  moderate  with  respect  to  x. 

B.3  EVALUATION  OF  RIDF’S  BY  NUMERICAL  INTEGRATION 

Although  the  integrals  involved  in  determining  the 
expected  values  indicated  in  Eq.  (B.1-2)  cannot  be  evaluated 
analytically  in  closed  form,  useful  results  can  be  obtained 
by  direct  numerical  integration.  The  implementation  of 
numerical  solutions  to  Eq.  (B.1-2)  proceeds  as  follows: 

Given  the  input  means  (x,y)  and  covariances  (P^x'  ^yy’  Pxy^ 
of  the  gaussian  random  variables  (x,y),  first  determine 
the  lower  triangular  transform  matrix  T, 

= T(x-x)  (B.3-1) 


0(x)  S 0(x)  + I (x-3i)  + 


ii 

ay 


x=x 


which  results  in  u being  a zero-mean  gaussian  random  variable 
with  covariance 


B-4 


THE  ANALYTIC  SCIENCES  CORPORATION 


T “ [o  °]  “ '’“ 


(B,3-2) 


This  operation  thus  transforms  ellipses  of  constant  proba- 
bility, 


(x-x)^P~^(x-x)  = constant 


in  the  (x,y)  plane  into  circles  centered  on  the  origin  of  the 
(u,v)  plane.  The  (u,v)  plane  is  then  divided  into  n^xn^  cell 
in  polar  coordinates,  as  shown  in  Fig.  B.3-1.  The  center  of 
each  cell  is  then  accorded  a weighting  which  depends  only 
on  the  gaussian  assumption  and  on  its  radial  distance  from 
the  origin;  the  cells  bounded  by  (j-l)Ar  and  jAr  have  the 
weighting 


Wj  = ^ exp(-i(j-i)^Ar^)  (B.3-3) 

Integration  is  completed  in  the  (u,v)  plane  by  summing  over 
the  cells, 

“a 

w.  / j tan 
^ k=l 

where 

Ujj^  = (J-i)Ar  cos((|)j^) 

Vjj^  = (j-i)Ar  sln((fj^) 

(|».  = 2ir(k-l)/n  (B.3-5) 

zC 


( 


’“"jk’''jk>y 


(B.3-4) 


and  X and  y are  found  by  inverting  Eq,  (B.3-1), 


Figure  B.3-1 


Transformation  of  Variables  for 
Nvunerical  Integration  of  Random- 
Input  Describing  Functions 


y<V''jk’  * ''jk  * y 

The  numerical  integration  of  E((x-x)8)  required  for  the 
evaluation  of  the  random  component  ridf’s  as  indicated  in 
Eq.  (B.1-2)  is  performed  in  a directly  analogous  manner. 

Observe  that  this  technique  is  perfectly  general 
with  respect  to  the  assumed  joint  probability  density  function 
(pdf)  of  X and  y.  If  the  gaussian  joint  pdf  is  denoted  p(x,y) 
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then  the  truncated  gausslan  pdf  upon  which  the  QKF-T  is  based 
is  defined  by 

(p(x,y)  + p(-x,y)  , X > 0 

pmCx.y)  = { (E.3-7) 

( 0 , X < 0 

The  same  niunerical  integration  subroutine  which  evaluates  §jj, 

Eq.  (B.3-4),  was  thus  simply  modified  to  calculate  0^,  or  § 
based  on  the  joint  pdf  given  in  Eq.  (B.3-7),  for  use  in  the 
QKF-T  algorithm. 

Figure  B.3-2  portrays  the  evaluation  of  0 by  numerical 
integration,  for  90  cells  (nj.=5,  n^=18)  and  for  360  cells 
(n  =10,n .=36) , for  various  values  of  estimated  horizontal 
separation,  x.  Based  on  the  small  deviations  between  these 
results,  it  is  judged  that  90-cell  numerical  integration  is 
adequate  for  this  application.  The  plots  §,p,  §p  (corresponding 
to  the  result  obtained  by  applying  Eq.  (B.2-3)),  and  0(x), 
corresponding  to  the  use  of  small-signal  linearization,  Eq. 
(2.4-1),  are  also  depicted  for  the  sake  of  comparison.  Note 
that  as  X becomes  large  (relative  to  the  estimation  uncertainty), 
the  three  approaches  are  very  nearly  equivalent.  The  largest 

deviation  between  0(x)  and  §„  with  this  value  of  p occurs 

' N ^ *^xx 

for  X = /p^^  ; at  that  distance,  0jj  is  11  times  larger  than 
0(x).  The  power  series  approach  for  obi^sining  approximate 
ridf s presented  in  Section  B.2  leads  to  0p,  which  essentially 
diverges  for  small  x.  This  effect  for  small  estimated  hori- 
zontal separation  may  not  be  critical,  since  the  missile 
will  no  longer  be  in  a cruise  phase  when  it  is  so  close  to 
the  target.  In  the  middle  range  of  x,  however,  the  disparity 
between  0p  and  is  also  quite  large  — is  as  much  as  6 
times  larger  than  0p  — which  indicates  that  §p  may  not  be  a use- 
ful approximate  ridf.  On  the  other  hand,  since  6p  is  between 
0(x)  anc.  0j^  for  all  x greater  than  8 units,  a quasi-linear 
Kalman  filter  based  on  series-approximate  ridf's  can  be 
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Figure  B.3-2 


ESTIMATED  HORIZONTAL  SERARATION,  g (uniB) 

Arctangent (y/x)  ridf  s by  Numerical  Inte- 
gration and  Power  Series  Approximation 


expected  to  exhibit  a perforiTiKn.  i.aat  is  intermediate  to 
the  EKF  (based  on  0(x))  and  the  3 iL-urate  QKF  (based  on  9jj)  . 
so  the  fact  that  0p  is  not  an  accurate  ridf  may  not  be 
detrimental  in  this  application.  The  nongaussian-based 
ridf,  §,j,,  behaves  most  like  0p  for  moderate  and  large  x 
(x  > /p^);  as  X decreases,  0,j,  remains  small  compared  with 
the  other  results. 
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It  may  be  of  interest  to  compare  the  computer  time 
expenditure  required  by  the  EKF,  QKF-P  and  QKF-N:  A simu- 

lation of  a single  engagement  of  the  type  considered  in 
Chapter  3 necessitates  135  evaluations  of  0(x),  §p  or 
respectively;  the  corresponding  data  processing  times  are 
1.74  min,  1.81  min  (+3.7  percent),  and  2.17  min  (+24.5  percent), 
where  the  percentage  increases  indicated  for  the  QKF-P  and 
QKF-N  are  defined  with  respect  to  the  EKF.  Thus  the  compu- 
tational burden  for  th  QKF-N  is  not  a significant  problem. 

Sections  B.2  and  B.3  have  summarized  two  approaches 
used  to  generate  quasi-linear  representations  for  the  mea- 
surement arctangent  nonlinearity.  The  results  presented  in 
Chapter  3 demonstrate  the  performance  that  can  be  achieved 
using  the  ridf's  derived  in  this  appendix  as  the  basis  for 
the  design  of  a quasi-linear  Kalman  filter  to  estimate 
missile-target  range  from  measurements  of  LOS  angle. 
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